#include "dev_common.h"

void HAL_MspInit(void)
{
    __HAL_RCC_AFIO_CLK_ENABLE();
    __HAL_RCC_PWR_CLK_ENABLE();
}

void SystemClock_Config(void)
{
    RCC_OscInitTypeDef RCC_OscInitStruct = {0};
    RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};

    /** Initializes the RCC Oscillators according to the specified parameters
     * in the RCC_OscInitTypeDef structure.
     */
    RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
    RCC_OscInitStruct.HSEState = RCC_HSE_ON;
    RCC_OscInitStruct.HSEPredivValue = RCC_HSE_PREDIV_DIV1;
    RCC_OscInitStruct.HSIState = RCC_HSI_ON;
    RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
    RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
    RCC_OscInitStruct.PLL.PLLMUL = RCC_PLL_MUL9;
    if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
    {
        Error_Handler();
    }

    /** Initializes the CPU, AHB and APB buses clocks
     */
    RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK | RCC_CLOCKTYPE_SYSCLK | RCC_CLOCKTYPE_PCLK1 | RCC_CLOCKTYPE_PCLK2;
    RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
    RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
    RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
    RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;

    if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2) != HAL_OK)
    {
        Error_Handler();
    }
}


void Enable_CLK_GPIOA(void)
{
    __HAL_RCC_GPIOA_CLK_ENABLE();
}

void Enable_CLK_GPIOB(void)
{
    __HAL_RCC_GPIOB_CLK_ENABLE();
}

void Enable_CLK_GPIOC(void)
{
    __HAL_RCC_GPIOC_CLK_ENABLE();
}

void Enable_CLK_GPIOD(void)
{
    __HAL_RCC_GPIOD_CLK_ENABLE();
}

void Enable_CLK_USART1(void)
{
    __HAL_RCC_USART1_CLK_ENABLE();
}

void Enable_CLK_DMA1(void)
{
    __HAL_RCC_DMA1_CLK_ENABLE();
}

typedef void (*Enable_CLK_Func)(void);
typedef struct {
    void *dev;
    Enable_CLK_Func func;
} Enable_CLK;

const Enable_CLK g_clkFunc[] = {
    {GPIOA, Enable_CLK_GPIOA},
    {GPIOB, Enable_CLK_GPIOB},
    {GPIOC, Enable_CLK_GPIOC},
    {GPIOD, Enable_CLK_GPIOD},
    {USART1, Enable_CLK_USART1},
    {DMA1, Enable_CLK_DMA1},
};

void EnableDevCLK(void *dev)
{
    for (size_t i = 0; i < sizeof(g_clkFunc)/sizeof(Enable_CLK); i++) {
        if (g_clkFunc[i].dev == dev) {
            g_clkFunc[i].func();
            return;
        }
    }
}

/**
 * @brief  This function is executed in case of error occurrence.
 * @retval None
 */
void Error_Handler(void)
{
    /* USER CODE BEGIN Error_Handler_Debug */
    /* User can add his own implementation to report the HAL error return state */
    __disable_irq();
    while (1)
    {
    }
    /* USER CODE END Error_Handler_Debug */
}

#ifdef USE_FULL_ASSERT
/**
 * @brief  Reports the name of the source file and the source line number
 *         where the assert_param error has occurred.
 * @param  file: pointer to the source file name
 * @param  line: assert_param error line source number
 * @retval None
 */
void assert_failed(uint8_t *file, uint32_t line)
{
    /* USER CODE BEGIN 6 */
    /* User can add his own implementation to report the file name and line number,
       ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
    /* USER CODE END 6 */
}
#endif /* USE_FULL_ASSERT */
